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Abstract 


The  response  of  an  autonomous  vehicle  in  tracking  a  reference  path,  depends 
partly  on  the  nature  of  the  path.  The  condition  for  paths  that  are  intrinsically 
amenable  to  follow  are  briefly  presented,  and  then  a  method  for  the  generation  of 
amenable  paths  is  proposed  in  this  paper.  Previous  path  generation  methods  have 
sought  to  simplify  a  path  by  using  arcs,  superarcs,  polynomial  curves,  and  clothoid 
curves  to  round  comers,  which  result  from  poly-line  fits  through  a  given  sequence 
of  points.  The  developed  method  consists  of  two  steps:  First,  a  sequence  of  postures 
is  obtained  using  given  points,  then  each  pair  of  neighboring  postures  is  connected 
with  three  clothoid  curve  segments.  In  the  second  step,  a  completely  general 
method  to  connect  a  path  of  clothoid  curves  between  two  completely  arbitrary 
postures  was  not  envisioned  and  a  method  for  a  pair  of  adjacent  postures  was 
developed.  By  virtue  of  the  property  of  clothoid  curves,  a  generated  path  is 
continuous  with  respect  to  position,  tangent  direction,  and  curvature,  and  is  linear 
in  curvature.  Aside  from  the  properties  innate  to  clothoid  cu.  ves,  the  generated 
paths  transition  smoothly  into  turns,  pass  through  all  the  way  points,  and  sweep 
outside  the  comers.  For  interpolating  around  obstacles  that  are  commonly  inside 
the  comer,  these  properties  are  especially  useful. 
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1  Introduction 


The  robot  vehicle  navigation  problem  can  be  divided  into  four  subproblems: 
world  perception,  path  planning,  path  generation ,l  and  path  tracking,  which  can  be 
solved  separately  (Figure  1).  World  perception  senses  the  world  and  symbolizes  it 
into  features.  Path  planning  typically  uses  these  features  to  obtain  an  ordered 
sequence  of  objective  points  that  the  robot  must  attain.  Path  generation  converts 
the  sequence  of  objective  points  into  a  path.  Then,  path  tracking  controls  the 
vehicle  to  follow  the  path. 


On-line 

Real-time 


Figure  1:  Control  Structure  for  the  Autonomous  Vehicle 

As  with  any  control  system,  the  response  of  an  autonomous  vehicle  in  tracking 
a  reference  path  depends  partly  on  the  nature  of  the  reference  path.  Actuators  are 
not  perfect;  thus,  if  a  path  is  easier  for  a  robot  to  follow,  there  will  be  fewer  errors. 


1  Path  planning  and  path  generation  together  are  often  referred  just  as  path  planning.  Some  navigation 
schemes  do  not  generate  a  path,  but  compute  the  safe  instant  motion  of  the  vehicle  as  path  planning. 
[Khatib85,  Krogh84,  Feng89J 


not  perfect;  thus,  if  a  path  is  easier  for  a  robot  to  follow,  there  will  be  fewer  errors. 
For  a  robot  vehicle  whose  guide  point  is  at  the  center  of  its  rear  axle,  discontinuities 
are  troublesome  because  an  infinite  acceleration  of  the  steering  wheel  is  required  to 
track  the  reference  path.  A  real  robot  (with  finite  acceleration)  traveling  through 
such  transition  points  will  experience  an  offset  error  along  the  desired  path.  In 
addition,  the  extent  to  which  steering  motions  are  likely  to  keep  the  vehicle  on  the 
desired  path  can  be  correlated  to  the  linearity  of  curvature  of  the  path,  since  linear 
curvature  along  a  path  requires  linear  steering  velocity.  In  this  paper,  the  condition 
for  paths  that  are  intrinsically  amenable  to  follow  is  briefly  presented,  and  then  a 
method  for  die  generation  of  amenable  paths  is  proposed. 

Numerous  path  representation  methods  have  appeared  in  the  literature.  In 
the  simplest  method,  a  path  is  composed  of  a  sequence  of  straight  lines  and  circular 
arcs;  others  have  used  polynomial  splines  or  clothoid  curves.  Previous  methods 
have,  in  general,  sought  to  simplify  a  path  by  rounding  comers,  which  result  from 
straight  lines  connecting  a  given  sequence  of  points  [Kanayama85,  Nelson88].  The 
method  developed  in  this  paper,  however,  generates  a  continuous  path  with 
clothoid  curves  directly  from  the  given  points.  In  addition,  the  method  guarantees 
continuity  of  position,  heading  ,  and  curvature  along  the  generated  path.  Further, 
the  steering  rate  is  piecewise  constant 

The  following  section  presents  criteria  for  paths  that  are  suited  to  path  tracking. 
The  performance  of  a  vehicle  tracking  a  path  that  was  designed  without  concern  for 
ease  of  tracking  is  compared  with  performance  on  a  path  that  is  intrinsically  easier 
to  track.  Section  3  presents  a  method  for  generating  paths  with  clothoid  curves. 
Then,  in  Section  4,  the  results  are  shown  to  evaluate  the  performance  of  the 
proposed  method.  Finally,  Section  5  advances  the  conclusions  and  suggests  the 
directions  for  future  research. 
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2  Continuous  Paths 


2.1  Guide  Point 

For  our  analysis  a  bicycle  model  is  used  as  an  archetype  for  modeling  robot 
vehicles  with  two  degrees  of  freedom,  steering,  and  propulsion.  The  guide  point  is 
the  point  of  the  vehicle  that  is  controlled  to  follow  the  given  path.  The  choice  of  the 
guide  point  is  an  important  decision — it  affects  the  desired  steering  and  propulsion 
functions  required  to  follow  the  given  path  and  speed.  We  have  chosen  the  guide 
point  to  be  at  the  midpoint  of  the  rear  axle  (Figure  2)  resulting  in  the  following 
advantages: 

•  The  steering  angle  at  any  point  on  the  path  is  determined  geometrically, 
independent  of  speed,  in  the  following  manner  : 

tan  <)>=“:;  d  =  tan"1  cl  (1) 

where  l  is  the  wheelbase  of  the  vehicle  and  c  is  the  curvature  of  the  path. 


Figure  2:  Geometry  of  a  Bicycle  Model 

Also,  the  angular  velocity  of  the  driving  rear  wheel  is  determined  only  by 
the  vehicle  speed  (v)  and  the  radius  of  the  wheel  (Rw)' 
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If  the  guide  point  is  placed  elsewhere,  expressions  for  <]>  and  00  are  more 
complex  than  shown  in  Equations  1  and  2.  The  reference  steering  angle 
and  angular  velocity  of  the  driving  wheel  must  then  be  obtained  by 
numerical  integration. 

•  The  vehicle  is  able  to  follow  the  minimum  turning  radius  for  the 
maximum  steering  angle  [Nelson88].  In  other  words,  the  peak  steering 
angle  is  smaller  than  that  for  any  other  guide  point. 

•  The  heading  of  the  vehicle  is  aligned  with  the  tangent  direction  of  the 
path.  This  gives  a  more  reasonable  vantage  point  for  a  vision  camera  or  a 
range  scanner  mounted  at  the  front  of  the  vehicle,  as  in  Figure  3,  and  a 
smaller  area  is  swept  by  die  vehicle. 


Figure  3:  The  Heading  Alignment  along  a  Path 

For  the  guide  point  at  the  center  of  the  rear  axle,  paths  with  discontinuities  of 
curvature  will  require  infinite  acceleration  of  the  steering  wheel.  Consider  the 
motion  of  the  vehicle  along  a  path  which  consists  of  two  circular  arcs  (Figure  4). 
There  is  a  discontinuity  in  curvature  at  the  point  where  the  two  circular  arcs  meet. 
An  infinite  acceleration  in  steering  is  required  for  the  vehicle  to  stay  on  the  specified 
path  provided  that  it  does  not  oome  to  a  stop  at  the  transition  point,  simply  because 
it  takes  a  finite  amount  of  time  to  switch  to  the  new  curvature.  In  reality,  moving 
through  a  transition  point  with  non-zero  velocity  results  in  an  offset  error  along  the 
desired  path.  Likewise,  rotary  body  inertia  requires  continuity  of  heading,  and 
steering  inertia  requires  continuity  of  curvature. 


Figure  4:  Steering  along  Circular  Arcs 


This  is  not  the  case  if  the  guide  point  is  moved  from  the  rear  axle,  for  example, 
to  the  front  wheel.  However,  this  choice  loses  the  advantages  discussed  above. 

Selection  of  the  guide  point  is  important  to  the  formulation  of  the  path 
tracking  problem.  When  the  guide  point  is  chosen  on  the  center  of  the  rear  axle, 
steering  and  driving  reference  inputs  are  computed  from  the  path  parameters  and 
vehicle  speed,  respectively,  as  in  Equation  (2).  This  enables  the  planning  and 
controlling  of  steering  along  a  path  to  be  independent  of  speed.  It  is  referred  to  as 
path  tracking,  in  contrast  to  trajectory  tracking  in  which  steering  and  speed  are 
controlled  along  a  time  history  of  position  [Shin901. 

2.2  Vehide  Path  Modeling 

The  configuration  of  a  conventionally  steered  vehicle  moving  on  a  plane 
surface  can  be  described  completely  by  a  set  of  coordinates  ( x ,  y,  9V,  $);  vehicle 
position,  heading,  and  steering  angle,  respectively.  The  continuity  of  ( x ,  y,  0V,  0)  is 
recommended,  because  the  vehicle  has  inertia  and  finite  control  response,  which 
predude  discontinuous  motions.  Otherwise,  tracking  errors  will  be  greater.  Since  a 
path  spedfies  an  ideal  motion  of  a  conventionally  steered  vehicle,  a  path  must 
guarantee  the  continuity  of  ( x ,  y,  0V,  <t>)  of  a  vehicle. 

A  path  can  be  parameterized  in  terms  of  path  length  s  as  (x(s),  y(s)).  Tangent 
direction  (0(s))  and  curvature  (c(s))  can  be  derived  along  a  path: 
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0(s)  = 


dy(s) 

dx(s) 


c(s)  = 


dd(s) 

ds 


(3) 

(4) 


The  continuity  of  (x,  y)  is  guaranteed  if  a  path  is  continuous.  But  the  effect  of 
the  continuity  of  vehicle  heading  and  steering  on  the  path  depends  on  the  guide 
point  Since  the  guide  point  is  chosen  at  the  center  of  the  rear  axle,  as  mentioned  in 
Section  2.1,  the  heading  of  the  vehicle  6V  is  aligned  with  the  tangent  direction  of  the 
path  0,  and  the  steering  angle  $  is  determined  by  the  curvature  of  the  path,  as  in 
equation  (1)  Thus,  the  continuity  of  (x,  y,  0V,  0)  is  tantamount  to  the  continuity  of 
(x,y,0,c).  If  we  define  posture  as  the  quadruple  of  parameters  (x,y,0,c),  a  posture 
describes  the  state  of  a  conventionally  steered  vehicle,  and  a  path  is  required  to  be 
posture-continuous  for  easy  tracking.3 

Further,  the  rate  of  change  of  curvature  (sharpness)  of  the  path  is  important, 
too,  since  the  linearity  of  curvature  of  the  path  dictates  the  linearity  of  steering 
motion  along  the  path  (1).  If  we  assume  that  less  control  effort  is  required  for  an 
actuator  to  provide  a  linear  velocity  profile  than  an  arbitrary  nonlinear  one,  the 
extent  to  which  steering  motions  are  likely  to  keep  a  vehicle  on  a  desired  path  can  be 
correlated  to  the  linearity  of  curvature  of  the  path. 

Certain  spline  curves  [Nelson88]  are  good  candidates  for  good  paths,  because 
they  guarantee  posture-continuity  along  paths.  However,  these  spline  curves  do  not 
guarantee  linear  gradients  of  curvature.  Clothoid  curves,  by  contrast,  do  not  have 
the  same  properties  of  curvature  and  vary  linearly.  In  the  following  subsection, 
clothoid  curves  are  introduced  and,  are  compared  the  performances  of  a  vehicle 
tracking  a  clothoid  path  and  an  arc  path. 


3  Omni  directional  locomotion  systems,  such  as  an  ilonator  wheel  system  [Daniel85]  and  legged  systems, 
can  follow  paths  with  discontinuities  of  tangent  direction  and  curvature,  since  they  can  subtend  pure 
rotation  or  pure  lateral  motion.  However,  continuity  of  curvature  is  still  recommended  because  it 
provides  smooth  changes  in  the  centrifugal  force:  Fcg  9  r  =  ct/ 
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13  Clothoid  Curves 

Clothoid  curves  [Kanayama85,  Yates52]  are  a  family  of  curves  that  are  posture- 
continuous,  and  are  distinct  in  that  their  curvature  varies  linearly  with  the  length 
of  the  curve: 

cis)  =  ks  +  a  (5) 

where  k  is  the  rate  of  change  of  curvature  (sharpness)  of  the  curve  and  subscript  i 
denotes  the  initial  state.  A  clothoid  curve  segment  is  shown  in  Figure  5. 


Figure  5:  A  Clothoid  Curve 

Given  an  initial  posture,  sharpness  of  the  clothoid  segment,  and  the  distance 
along  that  segment,  position,  orientation,  and  curvature  at  any  point  along  the 
curve  are  calculated  as  (5, 6, 7,  and  8): 

0(s)  *  0{  +  J  ciQdt,  -  -js2  +  cjs  +  0i 


(6) 
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s  0 

x(s)  =  Xi  +  f  cos  0(5)  <*5  =  J  cos{^52  +  CiS  +  0i }d%  +  Xi  (7) 

0  $ 

s  0 

yis)  =  y\  +  J  sin  0(5)  <*5  =  J  sin  ( ^  52  +  a  5  +  00  d5  +  y\  (8) 

The  response  of  a  robot  vehicle  to  different  reference  paths  was  compared. 
Open  loop  responses  of  a  vehicle  following  a  path  composed  of  arcs  and  straight 
lines,  and  another  composed  of  clothoid  segments,  are  shown  in  Figures  6,  and  7: 
The  vehicle  is  made  to  follow  a  set  of  steering  commands,  which  are  obtained  from 
the  path  specification  using  (1),  without  trying  to  compensate  for  tracking  errors. 
The  dynamic  responses  of  the  vehicle  are  modeled  as  first  order  lag  systems  with 
hard  limits  on  acceleration.  In  each  case,  the  reference  path  is  indicated  by  dashed 
lines,  while  the  actual  path  is  indicated  by  solid  lines.  Simulation  results  show  that 
an  arc  path  results  in  larger  steady  state  tracking  errors  caused  by  discontinuities  in 
curvature,  as  well  as  the  parameter  variation  of  actuator  and  vehicle  speed. 

While  the  results  shown  above  support  the  claim  that  "good"  paths  are 
intrinsically  easier  to  track,  it  turns  out  that  when  using  an  optimized  closed  scheme 
and  fast  actuators,  tracking  performance  is  only  marginally  better  for  smooth,  linear- 
curvature  paths  than  for  paths  composed  of  arcs  and  straight  lines,  especially  at  low 
speeds.  At  low  speeds,  the  compensating  controller  makes  up  for  errors  from 
curvature  discontinuities,  non-linearities,  and  imperfect  actuators.  For  tracking 
paths  with  significant  curvature,  it  is  essential  to  ensure  curvature  continuity  at 
high  speeds  or  with  slow  actuators. 


(A)  Along  a  path  composed  of  arcs  and  straight  lines 


mUI*  mr  0.0*  ag  0.0Z5  Man  0.071 
valacttg  art  5.000  ag  a. 000  aav  5.000 


(B)  Along  a  path  composed  of  clothoid  segments 
Figure  6:  Open-loop  Performance:Time  Constant  =  0.1  s,  Vehicle  Speed  =  5  m/s 


(A)  Along  a  path  composed  of  arcs  and  straight  lines 


(B)  Along  a  path  composed  of  clothoid  segments 
Figure  7:  Open-loop  Performance:Time  Constant  =  0.5  s.  Vehicle  Speed  =  2  m/s 
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3  Generating  Posture-Continuous  Paths 


The  previous  section  discussed  the  condition  for  a  path  that  is  intrinsically  easy 
to  follow.  This  section  presents  a  method  to  generate  such  paths.  The  problem 
posed  in  generating  paths  is:  how  to  produce  a  unique,  easily  tradeable,  continuous 
path  from  a  given  sequence  of  points.  This  problem  is  similar  to  those  addressed  by 
previous  path  generation  methods  [Kanayama85,  Nelson88]. 

3.1  Existing  Path  Generation  Methods 

Hongo  et  al.  proposed  a  method  to  generate  continuous  paths  composed  of 
connected  straight  lines  and  circular  arcs  from  a  sequence  of  objective  points  (Figure 
8)  [H6ngo85].  While  paths  composed  solely  of  arcs  and  straight  lines  are  easy  to 
compute,  such  a  scheme  leaves  curvature  discontinuities  at  the  transitions  of  the 
segments,  as  discussed  previously. 


(A)  By  Arc  method  (B)  By  Cubic  Spline  Method  (C)  By  Kanayama’s  Method 
Figure  8:  Paths  Generated  by  Existing  Methods 

Kanayama  proposed  pairs  of  clothoids  segments  as  a  method  to  interpolate 
between  given  points  [Kanayama85].  The  problem  with  clothoids  is  that  though 
they  guarantee  smoothness  and  linearity,  it  is  non-trivial  to  generate  clothoid 
segments  for  arbitrary  starting  and  ending  postures;  the  expressions  for  these  curves 
are  underconstrained,  and  further,  no  closed  form  expression  is  available.  (The 
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expression  must  be  evaluated  using  numerical  methods.)  Kanayama's  scheme  is 
tenable  under  the  simplification  made  by  the  requirement  that  the  starting  and  the 
ending  curvature  at  the  via  points  are  always  zero.  This  model  is  adequate  for 
simple  paths  for  which  symmetric  pairs  of  dothoid  curves  can  be  found  or  for  paths 
with  mild  curvatures  that  can  be  easily  broken  down  in  separate  dothoid  segments. 

Certain  polynomial  spline  curves  [Mortenson85]  are  candidates  for  path 
segments,  because  they  guarantee  continuity  of  posture.  Nelson  proposed  quin  tic 
spline  and  polar  spline  curves  [Nelson88]  obtained  from  two- point  boundary 
conditions.  However,  these  spline  curves  do  not  guarantee  linear  gradients  of 
curvature.  Clothoid  curves,  by  contrast,  do  vary  linearly  with  the  distance  along  the 
curve. 

3.2  Path  Generation  from  a  Sequence  of  Points 

The  following  two-step  method  generates  a  unique  posture-continuous  path 
from  a  sequence  of  points.  The  first  step  is  to  derive  a  sequence  of  unique  postures 
from  the  objective  points;  the  second,  is  to  interpolate  between  those  postures  with 
dothoid  segments.  Heading  and  curvature  at  the  starting  and  ending  positions  are 
presumed  from  the  configuration  of  the  vehide,  using  equation  (1). 


Figure  9:  Obtaining  Postures  and  Assodated  Circles  from  Objective  Points 
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Let  [X  =  (Xo, ...,Xn)  =  (Cto/yo)/---/(Xn/yn))]  be  a  sequence  of  objective 
points.  The  associated  circle  at  Xj  is  defined  to  be  the  circle  which  passes  through 
points  Xj-i,  Xj,  Xj+i  as  in  Figure  9.  Then  the  heading  of  the  vehicle  at  Xj  is  taken  as 
the  direction  of  the  tangent  to  the  associated  circle  at  Xj ,  and  the  curvature  is  the 
reciprocal  of  the  osculating  radius  of  the  associated  circle,  denoting  the  posture  thus 
obtained  as  the  associated  postures ,  The  next  step  is  to  connect  neighboring  postures 
with  clothoid  segments. 

It  is  not  always  possible  to  connect  two  neighboring  postures  with  one  clothoid 
curve  segment,  because  four  governing  equations  (5,  6,  7,  and  8)  cannot  be  satisfied 
simultaneously  with  only  the  two  parameters  (sharpness  k  and  length  s)  that  a 
clothoid  curve  provides.  To  satisfy  these  four  equations,  at  least  two  clothoid 
segments  are  needed.  However,  the  general  problem  cannot  be  solved  with  only 
two  clothoid  segments.  Figure  10  shows  two  pairs  of  associated  postures  and  their 
associated  circles.  Let  Pi ,  Pf  denote  the  starting  and  the  ending  postures, 
respectively.  And  Ci,C/  denote  the  associated  circles  corresponding  to  the 
curvatures  at  Pi ,  Pf  .  They  are  drawn  by  solid  lines  and  dotted  lines,  respectively. 


(X) 


Figure  10:  Determination  of  the  Sign  of  the  First  Clothoid  Segment 

As  in  (A)  of  Figure  10,  if  the  orientation  of  Pf  is  outward  from  Q ,  the  ending 
part  of  a  solution  curve  should  be  inside  C; .  Then,  it  is  plausible  that  the  starting 
part  of  a  solution  curve  also  lies  inside  C,-  .  Similarly,  if  the  direction  of  the  Pf  is 
inward  into  C,-  ,  as  in  (B)  of  Figure  10,  it  is  plausible  that  the  starting  part  of  a 
solution  curve  lies  outside  C;  .  Note  that  the  sign  of  the  sharpness  determines  the 
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side  of  the  associated  circle  on  which  the  dothoid  segment  lies:  (1)  If  the  sharpness  is 
zero,  then  the  dothoid  curve  remains  on  the  assodated  drcle  in  question.  (2)  If  the 
sharpness  is  positive,  then  the  dothoid  curve  will  be  in  the  left  side  of  the  associated 
drde.  (3)  Otherwise,  it  will  be  in  the  right  side  of  the  assodated  circle.  Table  1  lists 
all  the  possible  cases  of  relative  geometry  of  the  first  and  last  segments  of  the 
solution  curve  to  the  drdes  C,-  and  Cf  (The  convention  used  is  that  negative 
curvature  equates  to  a  right  turn  and  a  positive  curvature  equates  to  left  turn). 
Hence,  a  solution  curve  should  satisfy  the  following  proposition: 

If  the  direction  of  Pf  is  outward  from  Cj,  the  sign  of  k  of  the  first  dothoid 
segment  is  chosen  so  that  the  curve  lies  inside  Cj. 

If  the  direction  of  Pf  is  inward  into  Cj,  the  sign  of  k  of  the  first  dothoid 
segment  is  chosen  so  that  the  curve  lies  outside  Cj. 

Otherwise,  k  of  the  first  dothoid  segment  is  chosen  so  that  the  curve 
remains  on  Cj.4 


Figure  11:  Determination  of  the  Sign  of  the  Last  Clothoid  Segment 

As  a  corollary  to  the  above  proposition,  the  sign  of  k  of  the  last  clothoid 
segment  can  be  determined  (Figure  11): 


4  In  this  case,  P,-  and  Pf  share  the  same  associated  circle,  two  postures  are  connected  with  the  part  of 
their  associated  circle,  which  is  a  clothoid  curve  of  zero  sharpness. 
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If  the  direction  of  P,-  is  outward  from  Cf,  the  sign  of  k  of  the  last  dothoid 
segment  is  chosen  so  that  the  curve  lies  outside  Cf. 

If  the  direction  of  Pi  is  inward  into  Cf,  the  sign  of  k  of  the  last  dothoid 
segment  is  chosen  so  that  the  curve  lies  inside  Cf. 

Otherwise,  k  of  the  last  dothoid  segment  is  chosen  so  that  the  curve  lies 
on  Cf. 


Figure  12  shows  all  possible  cases  of  curvature  variations  between  a  pair  of 
neighboring  postures.  Notice  that  the  signs  of  k  for  the  first  and  the  last  segments 
are  die  same  for  each  case.s  However,  the  sign  is  the  opposite  of  that  required  for 
the  curvature  variation  between  the  postures  for  all  the  cases  except  (C)  and  (D)  of 
Figure  12.  Thus,  the  general  problem  to  connect  a  pair  of  neighboring  assodated 
postures  cannot  be  solved  with  two  dothoid  curve  segments. 


3  Determination  of  the  sign  of  sharpness  can  be  quantitatively  summarized,  as  in  Appendix. 


curvature 


sharpness 


curve  location 


illustration 
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One  adequate  solution  set  of  the  dothoids  is  the  set  of  three  dothoid  segments 
(Jfc,  si ),  (-it,  S2>/  (it,  S3).  The  subscripts  denote  the  order  of  the  dothoid  segments  from 
P,-.  This  combination  is  plausible  for  the  following  reasons: 

1.  The  signs  of  sharpness  for  the  first  and  last  dothoid  segments  are  the 
same. 

2.  The  sharpness  for  the  second  dothoid  segment  is  equal  in  magnitude  and 
opposite  in  sign  to  the  first  and  last  segments.  This  enables  the  curve  of 
three  dothoid  segments  to  satisfy  the  curvature  variation  between  the 
starting  and  the  ending  postures  by  varying  si,  S2,  S3,  even  though  the  sign 
of  the  first  and  the  last  dothoid  segments  satisfies  the  curve  location 
requirement. 

3.  There  are  four  variables  in  the  combination:  k,  sj,  S2,  S3.  It  is  possible  to 
find  a  unique  solution  satisfying  the  following  four  equations  which 
describe  the  mathematical  relationship  between  the  starting  and  ending 
postures: 

Cf  =  Ci  +  k  (si  -S2  +S3 )  (9) 

0/  =  0,-  +  a  (S1+S2  +  S3)  +  k (S1S2 - S2S3  +  S3S1)  +  | .(s}-s}  +  s$) 

r 

Xf  =  *i  +  I  COS 

JO 

f 

y/  -  y.  +  I  swi 

JO 

where 

6i(4)  =  6i  +  CfS  + 

02®  =  9«  +  C.S!  +  +  (C{  +  ksi)$  - 

03(^>  =  0f  +  c,  (si+S2>  +  k  (S1S2)  +  k(sf-s£)  +  jc,  +  lc(si  -S2>}4  + 
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Since  Equations  (11)  and  (12)  contain  Fresnel  integrals,  for  which  there  is  no 
closed  form  solution,  the  values  of  k,  si,  S2,  S3  are  computed  using  the  numerical 
method  (Press861  outlined  in  Figure  13. 


Figure  13:  A  Numerical  Method  to  Compute  the  Fresnel  Integrals 

Initial  values  for  si  and  S2  are  chosen  to  be  j  of  the  average  of  the  lengths  of  two  of 

the  arcs  that  connect  P;  and  Pf .  Equations  (9)  and  (10)  are  used  to  compute  k  and  s. 
Then,  xc,yc  can  be  computed  for  the  quadruple  (fc,  si,S2,  S3)  using  Simpson's 
approximation.  Ideally  xc ,  yc  ~  Xf ,  yj  and  in  fact  values  of  si  and  S2  are  adjusted 
until  the  difference  is  within  a  threshold. 
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4  Results 


Connecting  a  pair  of  neighboring  associated  postures  was  accomplished 
successfully,  as  in  Figure  12,  using  three  clothoid  curves.  Figure  14  shows  the 
graphic  result  of  a  posture-continuous  path  generated  by  clothoid  curves  through 
the  given  seven  points.  As  the  first  step  of  the  proposed  method,  a  sequence  of 
seven  postures  were  generated.  (Seven  arrows  in  Figure  14).  Then,  three  clothoid 
segments  are  used  to  interpolate  between  neighboring  postures. 


Figure  14:  Posture-continuous  Path  From  a  Sequence  of  Seven  Points 

Figure  15  shows  a  comparison  of  the  performance  of  the  proposed  method 
using  arcs,  splines,  and  Kanayama's  method  [Kanayama85].  Parameters  of  curvature 
and  sharpness  were  constrained  equally  for  all  methods.  The  maximum  sharpness 
of  Kanayama's  method  and  the  maximum  curvature  used  in  the  arc  method  are  set 
at  the  same  levels  as  in  the  proposed  method.  Paths,  curvatures  and  sharpness 
along  the  paths  are  compared.  Paths  resulting  from  the  proposed  method  have  the 
following  advantages  over  other  methods: 

•  The  method  proceeds  from  an  arbitrary  sequence  of  points.  Generation  of 
postures  is  essential  to  exploratory  planning  where  goals  are  commonly 
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posed  as  an  evolving  string  of  points.  Paths  generated  by  the  proposed 
method  pass  through  all  the  objective  points,  as  in  Figure  15;  whereas 
paths  from  Kanayama's  method  and  the  arc  method  are  only  proximate  to 
many  of  the  points  because  these  methods  start  from  a  sequence  of 
postures  that  must  be  modified  to  ensure  curvature  at  the  via  points  is 
zero. 

•  The  method  guarantees  continuity  of  position,  heading,  and  curvature 
along  the  path.  Further,  sharpness  is  piecewise  constant. 

•  Paths  generated  by  the  method  always  sweep  outside  the  acute  angles 
formed  by  straight  line  connection  of  the  way  points,  as  in  Figure  15.  The 
resulting  paths  are  especially  useful  for  interpolating  around  obstacles  that 
are  commonly  on  the  inside  of  angles.  In  contrast,  Kanayama's  paths  are 
always  inside  path  angles. 
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5  Conclusion 


Posture-continuity  is  presented  as  the  condition  for  a  path  that  is  intrinsically 
easy  to  track.  In  addition,  the  linearity  of  curvature  of  the  path  is  correlated  to  linear 
steering  motion,  facilitating  path  tracking.  Clothoid  curves  are  good  path  candidates 
to  satisfy  the  condition.  Simulation  shows  better  performance  of  a  vehicle  tracking 
paths  of  dothoids  versus  paths  of  arcs. 

A  method  for  generating  a  continuous  path  was  developed.  This  method  uses 
dothoid  segments  and  consists  of  two  steps:  First,  a  sequence  of  the  postures  is 
obtained  using  the  objective  points.  Then,  each  pair  of  neighboring  postures  is 
connected  with  three  dothoid  curve  segments. 

The  method  provides  additional  advantages  in  that  preprocessing  of  the 
objective  points  is  not  necessary,  as  with  arc  and  zero  curvature  dothoids.  Further, 
the  geometry  of  the  paths  generated  always  sweeps  outside  the  acute  angles  formed 
by  a  straight-line  connection  of  the  way  points.  These  are  especially  useful  for 
interpolating  around  obstades  that  are  commonly  on  the  inside  of  angles. 

The  method  of  obtaining  postures,  as  in  Figure  9,  requires  that  the  drcles 
formed  by  the  radii  of  curvature  of  two  postures  intersect.  Relaxing  such  a 
constraint  would  require  heuristics  to  determine  intermediate  postures.  Assuming 
intermediate  postures  could  be  found,  such  that  the  assodated  drcles  intersect,  the 
method  could  then  be  used  on  the  new  set  of  postures.  Thus  far,  the  search  for  a 
completely  general  method  that  would  generate  a  path  between  two  completely 
arbitrary  postures  has  not  been  fruitful. 

Directions  for  future  research  indude  the  following:  (1)  optimization  of  the 
lengths  of  more  than  three  clothoid  segments  on  the  premise  that  some  cost 
function  can  be  used  to  find  a  better  solution  than  the  results  here;  (2) 
improvement  of  the  numerical  method  to  connect  postures  through  the  Fresnel 
Integral  to  improve  speed  and  accuracy. 
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Appendix 

Determination  of  the  Sign  of  Sharpness 


Figure  Al:  Relative  Geometry  of  Associated  Postures 

When  a  pair  of  neighboring  associated  postures  are  connected  with  clothoid 
curves  as  in  Section  3.3.2,  the  sign  of  sharpness  for  the  first  and  the  last  clothoid 
segments  can  be  determined  quantitatively  as  follows.  Let  ui,uf  be  unit  vectors 
which  have  the  direction  of  Pi  and  Pf  respectively,  as  in  Figure  Al.  A  straight 
forward  test  can  be  applied  to  determine  whether  the  posture  is  inward  or  outward 
from  Cj  or  Cf : 

If  uf  •  FOi  <  0 ,  Pf  is  outward  from  Cj . 

If  uf  •  FOi  >  0 ,  Pf  is  inward  into  C,- . 

If  uf  •  FOj  =  0 ,  Pf  is  on  Cj . 

If  uj  •  10 f  <0,  Pi  is  outward  from  Cf . 


(A3.1) 
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If  uj  •  IOf  >  0 ,  Pi  is  inward  into  Cf . 

If  u{  •  IOf  -  0 ,  Pj  is  on  Cf. 

While  the  If  condition  of  the  Proposition  is  described  as  Equation  (A3.1),  the 
then  result  is  quantitatively  described,  as  in  Table  1.  For  example,  if  the  first 
clothoid  segment  lies  inside  Q,  its  sign  is  determined  by  ct*  (the  curvature  of  Q ): 

If  c,-  >  0 ,  ki  >  0 

If  Ci  <  0 ,  k{  <  0  (A3.2) 

If  c,-  =  0 ,  the  sign  of  ki  is  determined  as  the  sign  of  kf. 

Combining  (A3.1)  and  Table  1,  the  sign  of  sharpness  is  determined  as  follows: 

If  uf  •  FOi  •  Cj  <  0 ,  ki  >  0 

If  uf  •  FOi  •  ci  >  0 ,  Jtj  <  0 

If  uf  •  FOi  •  Cj  -  0 ,  the  sign  of  k{  is  determined  as  the  sign  of  kf. 

If  ui  •  FOf  •  cf  <  0 ,  kf  >  0 

If  ui  •  FOf  ,Cf>0,  kf  <  0 

If  ui  •  FOf  •  Cf  >  0 ,  the  sign  of  kf  is  determined  as  the  sign  of  k{. 

Note  that  the  proposed  method  cannot  be  generalized  to  the  case  where  both 
neighboring  curvatures  are  zero.  However,  this  configuration  is  never  generated  by 
the  first  step  shown  in  Figure  8.  If  necessary,  this  case  can  be  solved  using  clothoids 
with  zero  curvature  transitions  [Kanayama85]. 
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